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abstract 

NASA is developing a mechanism to manipulate and insert Racks into the Space Station 

Insertion End Effector (RIEE) with 5 hand wheels for precise alignment. The robot! 
section has been tasked with the automation of the RIEE un . 

Inthisreport for the automation of the RIEE uiiit , application of the Per^ptics Vis wn 

Svstem has been conceptually developed to determine the position and orientation of th 
RIEE relative to the logistic module and a MathCad progr^n is wntten o^ isp 
needed displacements for precise ahgnment and final insertion of tl 

The uniaueness of this report is that the whole report is in fact a MathCad P r °S r ^i 
including text, derivations and executable equations with example inputs an outp 
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RACK INSERTION END-EFFECT OR (RIEE) AUTOMATION 
Narasimha S. Malladi, 1993 Summer Faculty Fellow, Tuskegee University 


1. INTRODUCTION 

Towards the automation of the RACK INSERTION END-EFFECTOR (RIEE) Mechanism Application of 
tiie Perceptics Vision System has been conceptually developed to detennme the position and onentation of the 
RIEE relative to the logistic module and a MathCad program is written to compute and display the 
displacements required to 

1) Align the RIEE relative to the logistic module to prepare for final insertion of the Rack, and 

2) Translate the Rack Rotation axis and rotate the Rack about it for the Final Insertion. 

The above displacements are used for the actuation of motors to be incorporated in the Improved RIEE 
Mechanism. 

The following sections describe concepts, derivations of fonnulae and the MathCad program with sai ”Pk 
input and output. With the help of this report a scaled prototype of the Improved RIEE Mechanism wi 
integrated Vision System can be quickly developed and tested. 

2. THE RIEE MECHANISM 

The RIEE is a space mechanism with 5 degrees of freedom. It has 12 links and 15 joints. 1 It t is used to align 
the axis of rotation of the Rack and perfonn the final insertion of the Rack into the logistic module. The 
boom, carrying the RIEE, has 4 degrees of freedom. Fig. 1 and Fig.2 show the RIEE m retracted and 
installed positions as per drawing set # 82K0393 1 . 




Tmrnirn 


Fig. 1 
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Fig. 2 


3. DETERMINATION OF THE COORDINATES OF THE TARGETS IN THE CAMERA FRAME 


To insert the rack we have to know the positions of the rack attach points on the module, shown as 
I° w " the Fig. 3 below. In the following analysis, we derive the expressions for 

the coordinates^ of the left and right lower support points by getting ^ 

susnended vertically from the supports employing a set of two cameras for each target. 1 8 

SeShb of the cameras to the targets in the y-z plane of the boom ccwrdmate^stem 
Sh ™? „ 1?PTFF mechanism The RIEE mechanism has 2 end effector points on the left and right 
sides shown by lettter E, and a top end effector point P Diffemet views of this mechanism can e 
studied in the set of drawings # 89K0393 1 The points shown in the figure cany prefixes R for 
"Right” and "L" for "Left" in the analysis that follows. 


RIEE MECHANISM SCHEMATIC 

(Motto scale) 



Figure 3 
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TARGET AND CAMERA ARRANGEMENT SCHEMATIC 

(Not to scale) 





Figure 4 the frame .ha. carries dte cameras of ,he Vision Sysrem is called dre Camera fram. A coordma,e 

* n Y Y 7 is established at 0 7 . X 7 Y 7 plane is the plane containing the axes of the all 4 cameras It 
system O 2 X 2 Y 2 Z 2 is establisneaaiw 2 2 2F r calibration The camera frame is called 

should be made sure that all the camera axes are co-planar with proper calibrate . 

frame 2. 

In Figure 4, camera 1 and camera 2 are used .o ge. d,e coordina.es of dte ^ of 

Q2 and Z C2* ^ et ^ ie ^^ tance ^ rom t ie camera ^ to t ie ® yy C2 

following derivation we determine by eliminating y C2- 


Z C1 := 1 

x C l := " 2 


X C2 : 

d TC 


-.707 
= 20 


d C1 := io 
d c2 := io 

d C12 := d Cl + d C2 


z coordinate of Right Target image centroid from Camera 1 
x coordinate of Right Target image centroid from Camera 1 

x coordinate of Right Target image centroid from Camera 2 
Nominal Distance of die Target from the line of Cameras 

Distance of Target from Camera frame 

Distance of Camera 1 from origin of frame 2 (camera frame) 
Distance of Camera 2 from origin of frame 2 (camera frame) 
Distance between camera 1 and camera 2 


a 


C12 


:= atan I 


C12' 
d TC 


Angle between axes of camera 1 and camera 2 


The coordinates of .he right targe, in frame #2 situated as shown in Fig. 3 are given by: 

Using the output of camera 1 Usin S ,he oul P ut of Cam " a 2 

, ri , x RT 9 = x C2 *cos(al2) + y C2 *sin(al2) - d C2 12] 

X RT2-*C1 + Cl y RT2 = -x C2 *sin(al2)+y C 2*cos(al2) [4] 

yRT2 = yci [3] RT2 ^ 


•RT2 = Z C 1 PI Z RT2 = Z C2 

equating the right hand sides of equations [1] and [2], and rearranging, we have: 


[ 6 ] 


C2 


Cl - x C2 cos ( a C12) +d Cl + d C2 

sin ( a CI2) 
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or 



+ d C12 


Substituting the above expression for yc2 11110 equation [4], we have 


y RT2 


= “X 


C2‘ 


sin 


( a C12) 


+ 


C 1 


Cl 


C2' 


COS 


(c c C12 ) + d C12 ) • cos (a CI 2 ) 

sin (ct CI 2 ) 


y RT2“ 


sin^a^-.^ + x Cl‘ cos 




Cl 2' cos 



x C2 + x Cl' cos 


y RT2 : 


(a C12 ) + d cl2 cos C12 ) 


sin 


( a C12) 


y RT2- 


(d C12 + *■ ci) • cos ( a CI 2 ) x C2 
sin (a CI 2 ) 


Coordinates of Right Target in frame 2 are: 



n 

+ 

Q , 

n 

M .. 

(d ci2 + x cO cos ( a CI 2 ) x C2 

_ 1 
*1 

sin (a ci 2 ) 

\ z RT2 / 

\ / 
Z C1 


RT2\ 

^ 8 \ 

y RT2 = 

18.9998 

RT2 / 

U / 
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Figure 4, centra 3 and camera 4 are used ,o get rhe coordma.es of rhe left targe,. The " 
bv camera 3 are x r3 and z c3 which are perpendicular io the axis of the camera. Let the distance of targ 
fmm the camera 3 ” y c3 which cannot be measured. The coordinates obtained by camera 4 are x c4 and 
^ Let the distance fmm the camera 4 to the left target by y c4 , which cannot be measured. y c3 >s 
detennined by eliminating y c4 ill dm same way we did as for die right target. Followtng sunrlar subsututtons 

and simplifications, we get the coordinates of the left target in frame 2. 


z C3 := " 1 

z coordinate of Left Target image 


x coordinate of Left Target image 

x C3 := " 2 


x C4 := -2.121 

x coordinate of Left Target image 

d C3 := 10 

Distance of Camera 3 from origin 0 


C4 


:= 10 


d c34 := d C3 + d C4 


Distance between camera 3 and camera 4 


a 


C34 


:= atan I 


_C34' 
1 TC 


Angle between the axes of camera 3 and camera 4 


The coordinates of the left target in frame #2 situated as shown in Figure 4 are given by: 

Using the output of camera 3 Using the output of camera 4 

, X, T? = x C4 *cos(a C34 ) -y C 4* sin ( (X C34> +d C4 

xt T2 “ X C3 " d C3 

y LT2 = X(34*sin(a^i2) + yC4* cos ^ a C34^ 

Z LT2 = Z C4 

y c4 in the above is eliminated by following the procedure adopted for the right target. 

Coordinates of Left Target in frame 2 are: 


yLT2=yc3 
Z LT2 = Z C3 


x LT2 X 
y LT2 
v z LT2i 


C3 


- d 


C3 


(d C34 - x C3~) ' c os ( a C34) + x C4 
sin C34 ) 


C3 


un\ 

hl2 

y LT2 

= 19.0005 

LT2 j 

V-i 1 
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4. DETERMINATON OF COORDINATE SYSTEM ATTACHED TO THE RACK INTERFACE PLATE 
Derivation of the equations for detenntmng the frame et^poto (LE and RE) of the end 

" “P *>"* < p > rack on, ° Mis of 

'hee“deffeaor»dpom. S . See Figure 3 and Firgute 6 for dettuls. 


m ■= 10 
h .= 30 


g := J m 2 + h 2 


r G p := 15 Distance between G and P 

G is a reference point on the boom where tire end effector mechanism is connected, as shown in Figure 
Firgure 6. 

Coordinates of point G: 


Distance between CE and CR 
Distance between CE and P 

Distance between CR and P 

Distance between G and P 


g = 31.6228 


In the following, IAB indicates the magnitude of vector AB, and X AB* VAB^AB W 

coordinates of the vector AB . The points that join the vectors are shown in Fig. . 

Further, the "R" and "L" in the subscripts always means "Right" and the "Left respectively. For example, 
XRB indicates the x coordinate of Right B (point B on the right side). 


RBD 


:= 5.25 
:= 5.25 


:= 3.125 
:= 3.125 


'.= 23.25 
:= 23.25 
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r RBC := J r RBF 2 + r RFC 2 
r LBC := J r LBF 2 + r LFC 2 


Coordinates of Right B 
\ 


* RB 

y RB 

\ z RB / 


rioo 1 
••= I o 
0 


RBC 


= 23.4591 


r LBC = 23 4591 


Coordinates of Left B 



Components and magnitude of vectors AB 
y RAB := ” 17 z RAB ;= " 11 


y LAB := 17 z LAB = 


r RAB , y RAB 2 + z RAB 2 


r RAB “ 20 :2485 


r LAB := J y RAB 2 + z LAB 2 


LAB 


= 20.2485 


Nominal lengths of AC and DE 
r RACnom := 14 75 r RDEnom = 34 5 

Increments in AC nominal and DE nominal (right and left) 


r LACnom 14/75 r LDEnom 34 5 


A RAC = 0 

A LAC := 0 

A RDE = 0 
A LDE := 0 
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r RAC := r RACnom + A RAC 


r LAC := r LACnom + A LAC 
r RDE := r RDEnom + A RDE 
1 LDE := r LDEnom + A LDE 


r RAC = 14/75 
r LAC = 14 75 
r RDE = 34 5 
r LDE = 34 5 


The sets of points A,B and C on the right and left sides of the RIEE mechanism will each form a triangle. 
Here we derive die equations for finding the angle of die general (common to left and right) vector BC with 
known coordinates of points A and B, and the length AC in die y-z plane. Recalling Figure 5, we see: 



Firgure 5 


Vector AC = Vector AB + Vector BC 


y AC = y AB + r BC' cos ( 0 Be) z AC“ Z AB + r BC sin ( 0 Be) 

Squaring and adding the above equations and simplifying, we have: 

r AC 2 =r AB 2 + r BC 2 + 2 y AB r BC cos ( 0 Be) + 2 z AB‘ r BC sin ( 0 Be) 

Dividing by 2 x-qq and further rearranging, results in: 


+ 


y AB cos ( e Be) + z AB sm (° Be) 

r AB 2 + r BC 2 “ r AC 


AB 


+ r 


BC — r AC 


2r 


= 0 


’ r BC 


Let 


BC' 


2-r 


r BC 
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Hence 


y AB ( 9 Be) + 1 AB- sin ( 9 Be) + c BC-» 


The above equation is of the form: 


a- cos ( 0 ) + b- sin ( 0 ) + c 0 

Expanding the above equation using half angles, we have: 



a- (1 - t 2 ) +2 b t + c (l +t 2 )=0 or 

or 


(-a + c)t 2 + 2 -b-t + (a + c)-0 

( a - c)-t 2 - 2-b-t - (a + c)=0 


The above is a quadratic equation in "t" and has two 
given geometry is 


solutions. The solution that is valid according to the 


t= 


2-b + 1 


4- b 2 + 4- (a 2 - c 2 j 
2( a - c) 


or 


t=- 


b + y 


+ b z - cf 


( a - c) 


Therefore 0=2atan(t) 


The trigonometric equations to solve for the angle of vector BC 
C on the right and left sides of the R1EE are. 


in the triangles formed by points A,B and 


y RAB “ s ( e RBc) + 1 RAB' sto ( e RBc) + c RBC 0 md 
y LAB- «« ( e LBc) + z RAB sta ( e LBc) + ' LBC=» 

Where 

r RAB 2 + r RBC 2 _ r RAC 2 c = 15 8311 

c RBC 


c LBC 


r LAB 2 + r LBC 2 r LAC 
2' r LBC 


c LBC 


15.8311 
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0 2* atan | 


RAB 


r RAB 2 “ c RBC 2 


y RAB ” c RBC 


9 jjg C := 2- atan | 


LAB T ^ 


2 

p 2\ 

r LAB ' 

' c LBC 


y LAB “ c LBC 


0 xbq = -5.6652 ‘deg 


0 LBC = -5.6652 *deg 


The points B,C and F on the left and right sides form a right triangle and vector FC is P^leHo vector DE, 
therefore, the foUowing relationships are derived to compute the angles of DEs (left and right) from the 

positive y axis in the y-z plane. 


" r RBF) 


X p *" atan 
R ' r RFC) 

. r LBF1 

X t := atan 
L ' r LFCj 


9 RDE “ 9 RBC + ^ R 
9 LDE := 9 LBC + X L 


Vector RE = Vector RB + Vector RBD+ Vector RDE 


4 


n 


9 RBD - RDE 
Therefore, the coordinates of point RE are: 


X R = 7.6552 'deg 

X L = 7.6552 ’deg 

» RDE = '•» * deg 
»LDE= 1 "‘ deg 



RB 


K 


y RB + r RBD cos ^ 9 RDE 2 ) + * RDE C ° S (° 
z RB + r RBD'^f 9 RDE “ f) + r RDE sin ( e RDe) 


RE^ 


f 100 1 

y RE 

= 

34.6615 

1 


^■4.0488 , 
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Vector LE = Vector LB + Vector LBD + Vector LDE 

0 LBD = (° LDE “ 2 ) 

Therefore, the coordinates of the point LE are: 

x LB 



n ' 


y LB + r LBD' cos \ 0 LDE 2 ) + * LDE 


K' 


z LB + r LBD' sin \ 0 LDE 2 J + * 


sin 


( e lde) 
( e lde) 


( XLE ) 


[80 \ 

jy le 

= 

34.6615 

VleJ 


\-4.0488 , 


Components of the vector from Left end LE to right end RE are. 




f x RE^ 


( x LE\ 

- 

y RE 

— 

y le 

l 


[ z REj 


\ z LEl 


lre) 


[2°\ 

y LRE 

= 

0 

1 

LRE 1 


\0 / 


LRE 


-I 


x LRE 2 + y LRE + z LRE 


LRE 


= 20 


The Components of Unit vector U1 along the line from left end LE to right end RE 


* U1 \ x LRE 

y ui I := y LRE 

ziTi / LRE 


LRE 


' x Ul^ 


f>\ 

y ui 


0 

\ z Ulj 


\ol 


f UI 

The Coordinates of the point CE are: 


CE^ 


f x RE^ 


y ce 

; = 

y re 

— m 

CE 1 


[ z reI 
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Our intention now is to establish a Coordinate system attached to the V 1 

vectmsUl, VI &W1 along its x,y & z axes and Point CE as the origin.. U1 is already defined above. V 

will be defined along the line from CE to P. 



The equations are: 

C x p- x g ) 2 + (yp- y o ) 2 + C z p- z o) 2 =r GP 2 171 
(*p — *ce) 2 + (yp-ycE) 2 + C z p- z cE) 2=h2 [8] 
( x p~ x re) 2 + (y?~ypE) 2 + (?p~ z PE) 1=g2 [9] 

Subtracting equations [8] and [9] from equation [7], we get the following equations: 
a r x p + b r y P + c r z P + G 2 — x CE 2 - y CE 2 - z CE 2 = r GP 2 " h " 

a 2 - x P + b 2 - y p + c 2' z P + G 2 " x RE 2 “ y RE 2 ” z RE 2 = r GP 2 “ § 


316 


where 


a i : = 2 - (x CE - x q’) 

3 1 : 

a 2 := 2 ' ( x RE ” x G) 

a 2 : 

b i := 2 - (y ce _ y g) 

b 1 : 

b 2 := 2 ‘ ( y RE “ y G) 

b 2 

c 1 := 2- (z ce “ z G) 

c 1 : 

c 2 := 2 ’ ( z RE “ z G) 

c 2 : 

(3 2 : = x g 2 + y G 2 + z G 2 

G 2 


Equations [10] and [11] can be rearranged as: 
a i'X p + c i*z p=~b j-y p + k 1 [12] 

a 2‘ x P + c 2' z P =_b 2' y P + k 2 [ 13 ^ 

where 

k ! := r GP 2 - h 2 + x CE 2 + y ce 2 + z CE 2 “ G 2 k 1 

k 2 '■= r GP 2 _ g 2+x RE 2+ yRE 2 + z RE 2_G 2 k 2 

Equations [12] and [13] can be arranged in the following matrix form: 




-b i*y p + k { 

-b 2 -y p + k 2 , 


D 


12 := 




[14] 


D 12 = 


Using Cramer's Rule, we can solve for xp and zp 

/-b i-yp+ k i c i\ / a l _b 

\ b 2' y P + k 2 c 2/ _ \ 2 b 

x o=- Z P 


After simplifying, we have 


: 0 
: 20 

= 69.323 
= 69.323 
= -8.0977 
= -8.0977 

= 8 . 1 - 10 3 


542.8125 
2.3428* 10 3 


161.9539 


i'yp + k i\ 
2 ~y p + k 2 / 
D 12 
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x p=b 3* y p + k 3 
where 

-b i*c 2 + b 2' c l 


[15] 


z p=b 4‘y p + k 4 


[16] 


b a •= 


b 3 : = 


k 3 : = 


bi=fl 


u 12 

k l c 2” k 2 c 1 


"a j-b 2 a 2'b 1 

D 12 

a l k 2 “ a 2 k 1 


4 - 


D 


D 


12 


12 


k 3 = 90 


b 4 = 8.5608 


k /i — -67.033 


Recalling equation [7] and substituting for xp and z p from equations [15] and [16], we have: 

(x p - x G y + (y P - y o') 2 + C z P “ z G) 2=r GP 2 
( b 3'yp + k 3 _x G) 2+ (y p ~ y g) 2 + ( b 4'yp + k 4 -z G) 2=r Gp 

Expanding equation [17] and rearranging, we get: 

A y p 2 + B y p + C=0 

where 


[17] 

[18] 


A := b 3 2 + l + b 


B := 2- [b y (k 3 — x - y q + b 4- (k 4 - z <3) ] 

c := (k 3 - x G y + y G 2 + (k 4 - z G y - r Gp 2 


A = 74.2878 
B = —1.1477* 10 3 
C = 4.2684* 10 3 


Equation [18] is a quadratic in "yp" and has 2 solutions. The solution that is relavent to the geometry of 
the RIEE mechanism is: 


y P = 


/ 1 

f— ; \ 

(-B + i 

IB 2 - 4-A Cj 


2- A 


y p = 9.2129 
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Substituting yp 


p\ 


[b 3 y p + k 3 \ 

1 

y p 

; = 

y p 

V'pj 


^b 4 y p + k 4 / 


back into equations [15] and [16], the coordinates of P are given by: 

X p\ 

y p 

\ z p) 



The z-axis given by unit vector W1 


is along the line joining CE and P. Its components are given by: 


(x wi^ 


fx p - X ce\ 

y wi 

; = 

y p - y ce 

\ z W1 J 


\z p - z CE / 


h 


Wl\ 


[o \ 

I 

y wi 

= 

-0.8483 

\ Z W1 J 


\ 0.5295/ 


i uv jr o J 

components are given by: 


,x VI \ 


( x Wl^ 


( x Ul\ 

y vi ' 


y wi 

X 

y ui 

i 

\ z Vlj 

1 

\ z wi J 


\ z ui / 


lx vi ^ 


[0 

y vi 

= 

0.5295 

l 

\ z VlJ 


\ 0.8483 / 


i - r a oinno the negative direction of the unit vector 

The origin of the camera frame is situated at a distance of d 2 i g 

W2 from CE. Therefore: 


P := atan 


f y ce _ y p’ 


p = 58.0257 *deg 


— z 


CE i 


:= 12 


The components of the unit vectors of the camera frame (2) as seen 

by: 

\ / 0 \ 

;= I cos (p) 



\ z U21 


x V21 

y v2i 

\ z V21 


i-sin(p) j 
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The coordinates of the origin of the camera frame O 2 as seem 


from Rack Interface frame (1) are given by: 


021 \ 


y 021 


021 j 

\ 


-h 


-h 


sin 


(?) 

(P)j 


The transformation of coordinates of the right and left targets from the camera frame to the rack insertion 
frame is given by the following matrix equations. 


Note that in the 4 x 4 transformation matrix on the right hand side: 

the first column contains the components of the unit vector U2as seen in frame 1, 

the second column contains the components of the unit vector V2 as seen in frame 1, 

the third column contains the components of the unit vector W2 as seen in frame 1 > an 

the fourth column contains the coordinates of the origin of the camera frame as seen m ame . 


* RTl 


( x U21 x V21 x W21 x 021 ^ 


( x RT2 1 

y RTl 


y U 21 y V 21 y W 21 y 021 

. 

y RT2 

z RTl 


z U21 z V21 z W21 z 021 1 


i z RT2 

s 21 


\ 0 0 0 1 / 


\ 1 / 


x LT1 


f x U21 x V21 x W21 x 021^ 


( x LT2^ 

y LTl 

, = 

y U 21 y V 21 y W 21 y 021 

. 

y LT2 

z LT1 


z U21 z V21 z W21 z 021 


l z LT2 

S 21 


\ 0 0 0 1 i 


\ 1 / 


x RTl 


’ 8 

y RTl 


0.73 

z RTl 


-21.9422 

. S 21 . 


1 


x LTl 


-12 

y LTl 


—0.9662 

z LTl 


-23.0018 

s 21 


1 


5. SUPPORT COORDINATES IN BOOM COORDINATE SYSTEM: 


h T := 12 Height of the supports above the targets as in Figure 3. Support Coordinates are: 


x RS 


x U1 

X V1 

x Wl 

x CE \ 


/ x RTl ] 


x RS 


■ 98 

y rs 


y ui 

y vi 

y wi 

y ce 


y RTl 


yRs 

= 

53.6613 

z RS 

:= 

z Ul 

z V1 

z Wl 

z CE + h T 


z RTl 


z RS 


-3.0488 

S 1 


lo 

0 

0 

1 i 


1 1 


Si 


i 1 

x LS 


f x Ul 

x VI 

x Wl 

x CE \ 


( x LTl ^ 


x LS ‘ 


' 78 

y ls 


y ui 

y vi 

y wi 

y ce 


y lti 


y ls 


53.6619 

z LS ' 


l z Ul 

z V1 

z Wl 

z CE + h T 


1 z LTl 


z LS 


-5.0488 

Si 


i 0 

0 

0 

1 1 


\ 1 1 


S 1 


1 
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6. DISPLACEMENTS IN THE BOOM ROBOT AND THE RIEE MECHANISM. 

The center point CS on the litre joining the left and right lower support points is given by 


' x cs^ 


k RS + x LS\ 

y cs 

;r 

y rs + y ls 

\ z csJ 


\ Z RS + Z LSI 



88 

53.6616 

\-4.0488 


undisturbed. This displacement is shown exagerated in Firgure 7 be 


x CES\ 




( x CE \ 

y ces 

;r 

y cs 

— 

y ce 

i 

CES j 

\ z CS j 


\ z CE / 


,x CES\ 

h 

y ces = 

19.0002 

\ z CES / 

V-4.4409*10 15 , 



y Boom 
\ z Boom j 



x CES 
0 

i z CES 


x Boom^ 


h 

y Boom 

= 

0 

1 



-15 

\ z Boom j 


\-4.4409’ 10 j 
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The new coordinates of CE after the boom displacement 


k cen\ 


,x ce\ 


x Boom 

y CEN 

; = 

y ce 

+ 

y Boom 

^ z CEN i 


Z CE / 

\ 

z Boom / 

The new coordinates of Right and Left 

' x RBN^ 


RB^ 


x Boom\ 

y RBN 

;= 

y rb 

+ 

y Boom 

RBN j 


Vrb 


Boom i 

>x LBN^ 


,x lb' 


f x Boom' 

y LBN 

:= 

y lb 

+ 

y Boom 

\ z LBN ; 


\ Z LB) 


\ z Boom , 


' x cen\ 


'88 


y CEN 

= 

34.6615 


\ z CEN / 


p4.0488 j 


RBN^ 


98 

\ 

y RBN 


0 


\ z RBN j 


\-4.4409- 10 ~ 15 / 

l x lbn\ 


1 78 

\ 

y LBN 

= 

» 


\ z LBN I 


\“4.4409* 10 / 


The new coordinates of Right "E" and components of new right BE derived from Figure 5 are: 


/y ren\ (y cen\ 

\ z REN / \ z RS / 

/y RBe\ _ /y RE “ y rb\ 

\ z RBE / \ z RE “ z RB / 

/y rben\ /y ren\ _ (y rbn 

\ z RBEN / \ z REN / \ z RBN 



The new coordinates of Left "E" and components of left BE derived from Figure 5 are: 

(y LEN 
LEN 




' 34.6615 
r5.0488 , 


fy lbe\ _ /y le “ y lb\ 

\ z LBE / \ Z LE- Z LJB/ 


(y LBE 
\ z LBE 
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fy lben\ _ (y len\ _ fy lbn\ 

\ z LBEN / \ z LEN / \ z LBN / 

Tlie lenghts of the new BE and the new DE on the right and left sides are: 



r RBEN J 

[ 2 2 

y RBEN + z RBEN 

r LBEN = J 

y LBEN 2 + z LBEN 2 


1 2 r 2 

r RDEN := > 

1 r RBEN ~ r RBD 


r LDEN := J r LBEN 2 ” r LBD 2 

The new angles of the vector DE on the right and left side are: 

/ r RBD + z RBEN \ 

0 RDEN 2 atan yr p-pEN + y RBEN/ 

/ * LBD + z LBEN \ 

0 LDEN •" 2 ^ lyr LDEN + y LBEN/ 

The angles for the new BC on the right and left are. 

0 RBCN := 0 RDEN " *■ R 

0 LBCN 0 LDEN ~ X L 
The new BC components are: 

(y rbcn\ / r rbc cos ( e rbcn) 

\ z RBCN / \r RBC' sin ( 0 RBCn) 

r LBC' cos (° LBCn) 
r LBC sin ( 0 LBCn) 


(y LBCN 
[ z LBCN . 


r RBEN = 34 7953 
r LBEN = 35 0273 

r RDEN = 34,397 
1 LDEN = 3463 16 


0 RDEN “ 3,6512 * deg 

0 LDEN = 0,3326 * deg 

0 RBCN = " 4 0039 ’ deg 
0 LBCN = “ 7,3225 * deg 

fy RBCN 
\ z RBCN 

fy LBCN \ _ / 23.2678 
\ z LBCN ) ' 2,99 


/ 23.401 8 \ 
1-1.638 / 
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The new AC components arc: 


y racn \ _ /y rab \ /y rbcn 

\ z RACN / \ z RAB / \ z RBCN 

/y lacn\ /y lab\ /y lbcn' 

\ z LACN / \ z LAB / \ z LBCN ; 

The new AC lengths are: 

r RACN := JyRACN 2 + z RACN 2 

r LACN := | y LACN 2 + z LACN 2 
The new increments are: 

A RDEN := r RDEN " r RDE 
A RACN = r RACN ” r RAC 

A LDEN := r LDEN “ r LDE 
A LACN := r LACN ” r LAC 


rj := o.i 

The new rotations required are: 


V RDE 

V RAC 

V LDE ' 

V LAC : 


A RDEN 

: -2 "K 

A RACN 

• 2’ It 

A LDEN 

• 2- Jt 

A LACN 

-2* K 

T1 


fy RACN\ _ / 6.401 8 \ 
\ z RACN / V I2 - 638 / 

/y LACN\ _ / 6.2678 
\ z LACN / \ -13 " 

r RACN ” 14167 
r LACN = 15 3298 

A RDEN = “° 103 
A RACN = "°- 583 

A LDEN = 01316 
A LACN = 0 5798 


\jf — 370.8683 * deg 


\|f = “ 2 0989 * i()3 ‘ de s 


\|/ | j^ p — 473.7588 deg 


\|/ j = 2.0874*10“ *deg 
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' x LREN^ 

. 

l x RBN^ 


f x lbn\ 

y LREN 

: = 

y REN 

1 

— 

y LEN 

i 

\ z LREN j 

’ \ z REN j 


\ z LEN / 


r LREN := ] x LREN 2 + y LREN 2 + z LREN 
The new unit vector joining the left and right E s is 


LREN^ 


f 20 1 

y LREN 

= 

0 

1 

\ z LREN j 


\2 / 


r LREN “ 


20.0998 


' x UIN^ 


,x lren\ 

y uin 

:= 

y LREN 

\ z UIN j 


\ z LREN / 


1 

r LREN 


,x uin\ 
y uin 

U1N / 


f 0.995 
0 

\ 0.0995 


^LRS : = JC X RS- 3 l LS) 2+ C y RS-yLS) 2+ C Z RS Z LSV 


r LRS 


20.0998 


The unit vector joining the left and right lower supports is: 


us\ 


x RS - x Ls\ 


f^us\ 


0.995 \ 




1 



-5 

y us 

■ “ 

y rs “ y ls 

r LRS 

y us 

i 


-3.0052* 10 

1 OC 

\ z USj 


N 

70 

C/1 

1 

N 

K 


\ z us 


\ 0.0995 / 


Because these two unit vectors are now the same, they are parallel. 
Let the final coordinates of Right and Left "E be 


fy REF 
lz REF 


and 


I y LEF 
^LEF 


hi the forgoing equations 


the above are used in place of "new” coordinates for RE and LE 


y REN 
, z REN 


and 


y LEN 
z LEN 


;alculations are repeated to obtain the final 

^ . i 1 f 4.U« anrt I 


AC. 
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7. CONCLUSIONS AND RECOMMENDATIONS: 

In this report the procedure to obtain the necessary displacements to align the RIEE mechanism for the final 
insertion has been accomplished with example calculations. The MathCad software has allowed us to 
integrate the Text, Figures, Derivations and Calculations, saving time and space for a clear understandmg 
of the procedures and calculations. 

It is recommended that an experiment be set up to obtain the images of prototype targets and process the 
images to get the input data required for this software. The results of the software can then be verified be 
verified against the actual locations of the prototype targets. 

8. REFERENCES: 

A. Drawing set #82K03931 and associated drawings 


